#include <Stepper.h>

// kleurcombinatie stappenmotor
// M1- = Groen
// M1+ = Rood
// M2- = Blauw
// M2+ = Geel

int button = A0;

int motorPin1 = 5;      // Motor 1 richting
int motorPin2 = 6;      // Motor 2 richting
int motorPin3 = 4;      // Enable motor 1
int motorPin4 = 7;      // Enable Motor 2
int delayTime = 50;     // snelheid
boolean linksom = true; // draai linksom


int stepnumber = 50; // aantal stappen voor 1 rotatie van de as

int modus = 0;    // 1= full-step one phase, 2= full-step two-phase, 3= half-step

void setup() {
  pinMode(motorPin1, OUTPUT);
  pinMode(motorPin2, OUTPUT);
  pinMode(motorPin3, OUTPUT);
  pinMode(motorPin4, OUTPUT);
  
  Serial.begin(9600);
}

void loop() {
  
  leesknop();
  
  
  switch (modus) {
    case 0:
      // doe niets
      break;
      
    case 1:        // full step one phase
      if (linksom == true)
      {
        onephaseleft();
      }
      else
      {
        onephaseright();
      }
      break;
      
    case 2:        // full step two phase
      if (linksom == true)
      {
        twophaseleft();
      }
      else
      {
        twophaseright();
      }
      break;
      
    case 3:        // half step
      if (linksom == true)
      {
        halfstepleft();
      }
      else
      {
        halfstepright();
      }
      break;

}
}

